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(57) Zusammenf assung : Bei einem GPS-gestiitzten, mit Kalman-Korrekturfilter (30) ausgenisteten inertialen Kurs- und Lagerefe- 
renzsystem mit mehrachsigem faseroptischen Gyroskop ist erfindungsgemass vorgesehen zur Bestimmung und Kompensation des 
dutch Wellenlangenanderung einer gemeinsamen Lichtquelle (1) verursachten Skalenfaktorfehlers nur den fur die Messachse, z. B. 
die Vertikalachse (z), mit vergleichsweise hoher Bewegungsdynamik ermittelten Skalenfaktorfehler als Kalman-Filter-Koirektur- 
wert fur die Skalenfaktor-Fehlerkorreklur aller Messachsen (x, y. z) des FOGs heranzuziehen. Diese Skalenfaktor-Fehlerkoirektur 
wiid vorteilhaflerweise nur mit grossen Zeitkonstante eingesetzL Durch die Erfindung lasst sich eine zuverlassige Korrektur des 
Skalenfaktors fur alle Messachsen des FOG-Systems gewahrleisten, und zwar ohne zusatzlichen Hardware- Aufwand und lediglich 
durch Anpassung der Kalman-rnlterkoirekmr. 
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VERFAHREN ZUR BESTIMMUNG TJND KOMPENSATION DES DURCH WELLENLANGENANDERUNG 
VERURSACHTEN SKALENFAKTORFEHLERS IN EINEM GPS— GESTUTZTEN INERT I ALEN 
KURS- UND LAGEREFERENZ SYSTEM 



5 Die Erfindung betrifft ein Verfahren zur Besrirnmurig und Kompensation des durch 
WeUenlangenanderung bei mehrachsigen, aus einer gemeinsamen Lichtquelle ge- 
speisten faseroptischen Gyroskops (FOG) verursachten Skalenfaktorfehlers in ei- 
nem GPS-gestiitzten, mit Kalman-Korrekturfilter ausgeriisteten inertialen Kurs- 
und Lagereferenzsystem (INS-System). 

10 

Aus DE 196 51 543 CI ist es fur Kurs- und Lagereferenzsysteme mit uber GPS- 
Empfanger gestutztem Inertialsystem bekannt, bei iterativer Korrekbirbewertung 
einer Plattfonnrechnung mittels eines Kalman-Filters, die uber den GPS-Empfanger 
bereitgestellten Kurs- und Lagewinkel von den entsprechenden durch einen InertL- 

15 alsensor gelieferten Daten zu subtrahieren, um unabhangig von Beschleunigungs- 
sensoren eine genaue Kurs- /Lagereferenz mit vergleichsweise bober Bandbreite zu 
erhalten. Korrekturmodelle fur GPS/INS-Mechanisierungen von Kurs- und Lagere- 
ferenzsystemen mit Korrektur der INS-Werte uber ein Kalman-Filter sind bei Be- 
rucksichtigung untersctoedlicher StorgroJSen aucb aus der BucbverofFentlicbung 

20 Kayton/Fried, AVIONICS NAVIGATION SYSTEMS, A WILEY-INTERSCIENCE PUBLI- 
CATION, Second Edition 1997, S. 72 - 98 bekannt 

AHgemein ist es aucb bekannt dass die Fehler inernaler Sensoren, wie Nullpunkt- 
fehler, Skalenfaktor und Acbsenausrichtfebler bei solcben INS/GPS-Systemen mit 

25 Hilfe extemer Stutzmformation unter Anwendung einer Kalman-ratertechriik ge- 
schatzt und daTiaob zur Korrektur der Sensordaten benutzt werden konnerx. Satelli- 
ten-Navigationssysteme, wie das US-amerikanische GPS (Global Positioning Sy- 
stem), sind dazu.besonders geeignet da sie drifuxei mit bober Genauigkeit die Posi- 
tion und die Gescbwindigkeit nabezu kontinuierlich bereitstellen. Aus der Differenz 

30 zwiscben den Positions- bzw. Gescbwindigkeitsdaten des GPS und des inertialen 
Systems ist man durch Kalman-Filter in der Lage, die Fehler der inertialen Senso- 
ren zu scbatzen, um eine entsprecbende Korrektur vorzunehmen. 

Die Bestimmung der Sensorfehler mit Hilfe extemer Stutzinformation und Kalman- 
35 Flltertecbnik, wie earwahnt, setzt jedocb ein bestLmmtes MaJ3 an Bewegungsdyna- 
Tnik des Fahrzeugs, z. B. eines Fiugzeugs, voraus. Die verscbiedenen Fehlermecba- 
nismen der inertialen Sensoren lassen sich nur so anregen und konnen dann uber 



WO 2004/023077 PCTVEP2003/007830 



1 den Kalman-Filter beobachtet werden. Im Allgemeinen aber bewegen sich diese 
Fahrzeuge in einer horizontalen Ebene, wobei die Nick- und Rollbewegungen nur 
fur kurze Dauer gro£ere Werte annehmen. Andererseits geht bei sehr groJJen Lage- 
winkelanderungen, z. B. bei Akrobatikflugen von Flugzeugen, der GPS-Empfang 
5 ganz verloren, da die GPS-Antenne die Satellitensignale nicbt mehr empfangen 
kann. Der Skalenfaktor lasst sich jetzt nicht mehr zufcledensteUend schatzen bzw. 
bestimmen. Andererseits tritt eine Erhohung des Skalenfaktorfehlers aufgrund ei- 
ner Wellenlangenanderung der Lichtquelle erst nach langerem Einsatz der Systeme 
in Erscheinung. Bei Kurs - / Lagereferenz-Sy stemen bleibt die Reduzierung der Sy- 

10 stemgenauigkeit meistens unerkannt, da durch eine Lot- und Magnetsensorstut- 
zung der Fehler dieser Systeme weitgehend unterdruckt wird und sich damit als 
techniscb relativ unbedenklich erweist Bei ziikunftigen Aufgaben im Bereich insbe- 
sondere einer unterstutzten Tragheitsnavigation und bei hohen Anforderungen be- 
zuglich der Lagewinkelgenauigkeit ist aber eine Verbesserung der Skalenfaktorge- 

15 nauigkeit und deren Langzeitstabilitat unbedingt erforderlich. 

Der Erfindung liegt damit die Aufgabe zugrunde, ein Verfahren bereitzustellen, 
durch das sich die Skalenfaktorgenauigkeit insbesondere bei einem GPS-gestiitzten 
inertialen Kurs- und Lagereferenzsystem verbessern lasst, das mit einem mehrach- 
20 sigen faseroptischen Gyroskop ausgerustet ist, das aus einer gemeinsamen Licht- 
quelle gespeist wird. 

Die E^rfindung ist bei einem Verfahren zur Bestimmung der Kompensation des 
durch WeUemangenanderung bei mehrachsigen, aus einer gemeinsamen Lichtquel- 

25 le gespeisten faseroptischen Gyroskops (FOG) verursachten Skalenfehlers in einem 
GPS-gestutzten, mit Kalman-Korrekturfilter ausgerusteten inertialen Kurs- und La- 
gereferenzsystem erfindungsgemaJ3 dadurch gekennzeichnet, dass der fur eine Ach- 
se mit vergleichsweise hoher Bewegungsdynamik ermittelte Skaleixfaktorfehler als 
Kalman-Filterkorrekturwert fur die Skalenfaktor-FeMerkoiTektur aller Messachsen 

30 des FOGs mit niedrigerer Bewegungsdynamik verwendet wird. 

Die Erfindung beruht auf der Beobachtung und Feststellung, dass der Skalenfaktor 
zwar fur die vertikale Messachse eines dreiachsigen Inertialkurs- und Lagereferenz- 
systems bestimmt werden frarm, sich jedoch fur die horizontalen Messac hs en nicht 
35 zufriedenstellend schatzen lasst. Dadurch ergibt sich zwar eine gute Genauigkeit 
bei Itursanderungen, jedoch treten erhebliche Lagefehler bei groJSen Lagewinkelan- 
derungen auf. Diese Probleme lassen sich mit der Erfindung zuverlassig beseitigen. 
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1 In vorteilhafier Ausfuhrungsform der Erfindung wird also bei einem dreiachsigen 
Rurs- und Lagereferenzsystem der fur die Vertikalachse z ermittelte Skalenfaktor- 
fehler zur Fehlerkompensation fur die ubrigen Messachsen x, y zur Skalenfaktor- 
Fehlerkorrektur angewendet. 

5 

Mit der Erfindung werden die technischen Moglichkeiten des Kalman-Filters mit ei- 
ner modernen FOG-Technologie so verbunden, dass ein gr6J*eres Ma£ von Nutzen 
erreicht und der SkalenfaktorfeMer fur alle drei Messachsen insgesamt wesentlich 
besser kompensiert wird. 

10 

Die Erfindung und vorteilhafte Einzelrieiten werden nachfolgend unter Bezug auf 
die Zeichnungen in beispielsweiser Ausfuhrungsform naher erlautert Es zeigen: 



Fig. 1 ein Funktions-Blockschaltbild eines durch GPS-Daten-gestutzten 

15 (inertialen) Tragheitsnavigationssystems mit Kalman-Filter-Korrek- 

tur; und 

Fig. 2 das detailliertere Funkftons-Blockschaltbild zur Erlauterung der 

Fenlerkorrektur insbesondere der Skalenfaktx>rkorrektur nacb dem 
20 erfindungsgemaJ3en Verfahren. 



Der Skalenfaktor eines faseroptischen Gyroskops oder Faserkreisels innerhalb ei- 
nes inertialen Tragheitsnavigationssystems 10 wird durch zwei Faktoren ma&geb- 
lich bestimmt Die im (nicht gezeigten FOG) durch eine auJSere Drehrate erzeugte 

25 Sagnac-Phase wird durch die Wellenlange (bzw. Frequenz) des Lachts in der Glasfa- 
ser und durch die geometrischen Abmessungen der Faserspule (umwickelte Flache) 
bestimmt Bei einem ruckstellenden System wird des Weiteren die Skalierung der 
Ruckstellung (Skalierung: Drehwinkelinkrement/Sagnac-Phase) in der Faserkrei- 
sel-Regelschleife fur den Skalenfaktor bestimmend. Bei einer mebrachsigen, z. B. 

30 einer dreiachsigen FOG-Architektur 2 (s. Fig. 2), die von einer gemeinsamen Licht- 
quelle 1 gespeist wird, bes timmt und kontroUiert eine Hilfsregelschleife 3 in der 
FOG-Elektronik den elektrischen Skalenfaktor. Andererseits wird der durch die 
geometrischen /mechanischen Abmessungen der FOG-Sensorspulen beeinflusste 
Skalenfaktorfehler fiber die Systemkalibration (KalibrationsdaterO erfasst und mit- 

35 tels einer FOG-Fehlerkorrektur 4 kompensiert. Bei dieser Systemkalibration wird 
auch die Wellenlange der gemeinsamen Lichtquelle 1 indirekt berucksichtigL Insbe- 
sondere werden also Fertigungsfehler korrigiert Anderungen der Wellenlange der 
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1 gemeinsamen lichtquelle 1 im Betrieb werden nicht mehr erf asst. Das Finiktions- 
schaltbild der Fig. 1 verdeutLicht insoweit den Stand der Technik, bei dem ein 
durch ein GPS-Navigationssystem 20 unter Verwendung eines Kal man-Filters 30 
gestutztes inertiales Navigationssystem 10 veranschaulicht ist, dessen ausgangssei- 

5 tige korrigierte Navigationsdaten einem ubergeordneten Rechnersystem zur Verfu- 
gung gestellt werden. 

Das Problem der beispielsweise durch Alterungseffekte der Lichtquelle 1 sich veran- 
dernden Skalenfaktoren 1st naturlich bekannt. Zur Losung slnd bisher zwei relativ 

10 aufwandige Verfahren angewendet worden. Beim ersten Verfabren setzt man eine 
Laser-Licbtquelle ein, bei der durch weitere optische Elemente das fur den FOG-Be- 
trieb benotigte Spektrum erzeugt wird. Teuer sind dabei vor allem die zusatzlichen 
optischen Komponenten, sowie die nahezu doppelte erforderliche Faserlange auf- 
grund der groj3eren Wellenlange dieser Lichtquellen. Eine andere vorgeschlagene 

15 Moglichkeit besteht in der direkten Messung der Wellenlange und der damit ermog- 
lichten rechnerischen Kompensation des zugehorigen Skalenfaktorfehlers. Der dazu 
benotigte taterferometrische Messaufbau erfordert aber einige zusatzliche op t ische 
und elektrische Komponenten, die das Gesa mtsystem erheblich verteuem. Eine 
markt- und konkurrenzfahige Losung unter Anwendung dieser Moglichkeit existiert 

20 nicht 

Die Erfindung nutzt unter anderein die Erkenntnis aus, dass eine Wellenlangen an- 
derung der fur alle drei Messachsen einer sogenannten FOG-Triade gemeins a men 
Lichtquelle 1 sich auf alle drei Messachsen gleichermaJSen auswirkL Darauf basiert 
25 die erfindungsgemaj3e Idee, nfimlinh den sehr gut bestimmbaren Skalenfa ktorf ehler 
der vertikalen Messachse z auch auf die beiden horizontalen Messachsen x, y des 
faseroptischen Systems anzuwenden. 

Bei einer vorteilhaften Ausfuhrungsform der Erfindung wird zusatzlich beachtet, 
30 dass die horizontalen Achsen x, y ma3geblich an der Besfimmimg der sicherheits- 
kririschen Lagewinkel beteiligt sind, so dass die Skalenfaktor-Fehlerkorrektur nur 
mit einer groJSen Zeitkonstante erfolgen sollte. Dabei ist von Bedeutung, dass die 
Anderung der Wellenlange und damit die Erhohung des Skalenfaktorfehlers durch 
Alterung der lichtquelle uber einen Zeitraum von einigen Monaten erfolgt Der ge- 
35 naue Zusammenhang zwischen E^nsatzdauer und WeUenlangenverschiebung wur- 
de bisher zwar noch nicht untersucht oder statistisch erfassL Neben dem Zeitfaktor 
hat auch die Umwelt (Temperatur, Vibration, usw.) einen bedeutenden E>influss. Bei 
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1 Reparaturen mussten schon Lichtquellen nach Betriebszeiten von 8 bis 12 Mona- 
ten ersetzt bzw. das System nachkalibiriert werden. Die Zeitkonstante der Korrek- 
tur des Kalman-Filters sollte also in einem Bereich von 10 bis 20 Stunden liegen, 
wobei bei jedem neuen Flug auf dem zuletzt geschatzten Fehlerwert aufgesetzt wird. 

5 Die Berucksichtigung einer groJ3en Zeitkonstante ist demnach unter dem Gesichts- 
punkt der Sicherheit unproblematisch, da nur mit vergleichsweise sehr langsamen 
Veranderungen der DLchtwellenlange zu rechnen ist. 

Wie die Fig. 2 erkennen lasst, werden zur Korrektur von Systemfenlem im Kalman- 
10 Filter 30 auJSer bestimmten NuUpunktfehlertermen fur alle drei Messachsen die 
Skalenfaktoren fur diese Achsen x, y, z im Systemblock 31 korrigiert bzw. kompen- 
siert, und zwar nur unter Berucksichtigung eines zuvor bestirmmen Skalenfaktor- 
fehlers fur die vertlkale Messach.se z. Die korrigierten Daten werden dann zusam- 
men mit Beschleunigungsdaten fur alle drei Achsen x, y, z der Navigationsrech- 
15 nung 6 zugefuhrt und das Brgebnis zusammen mit den GPS-Navigationsdaten auf 
den Kalman-Filter 30 ruckgefuhrt 

Die Losungen und Vorteile der Erfindung lassen sich wie folgt zus amm enfassen: 

20 1. Bei einem GPS-gestutzten inertialen Kurs- und Lagereferenzsystem mit mehre- 
ren aus einer gemeinsamen Lichtquelle gespeisten FOG-Sensoren wird mit Hilfe 
von aus einer relativ hohen Dynamik ausgesetzten Messachse gewonnener Sy- 
steriiinformation unter Anwendung von Kalman-Fnteitechnik ein Skalenfaktor- 
fehler bei alien Messachsen gleic±iermaJBen kompensierL 

25 

2. Diese Fehlerkorrektur wird bevorzugt mit grower Zeitkonstante angewendet, um 
zu verhindern, dass kurzzeitige Storungen im Sutzsensor, z. B. dem FOG-Sen- 
sor, einer Verukalachse und die damit mogUcherweise verbundenen fehlerhaften 
Schatzungen das Inertialsystem korrumpieren konnen. Um zu verhindern, dass 

30 eine Fehlschatzung des Kalman-Filters das System korrumpiert, ist es vorteil- 

haft ein limit fur die Korrektur einzufuhren und bei Erreichen dieses Omits 
eine Warnung bzw. eine Wartungsanforderung auszugeben. 

3. Im Gegensatz zu anderen moglichen bekannten oder vorgeschlagenen Losungen 
35 wird mit der Erfindung eine zuverlassige Reduzierung des Skalenfaktorfehlers 

des gesamten FOG-Sy stems erreicht, und zwar ohne zusatzlich Hardware-Ko- 
sten. 
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1 Patentanspriiche 

1. Verfahren zur Bestimmung und Kompensation des durch Wellenlangenande- 
rung bei mehrachsigen, aus einer gemeinsamen Liclitquelle gespeisten faseropti- 

5 schen Gyroskops (FOG) verursachten Skalenfaktorfehlers in eixiem GPS-gestutzten, 
rait Kalman-Korrektiirfilter ausgerusteten inertialen Kurs- und Lagereferenzsystem, 
dadurch gekennzeichnet, dass der fur eine Achse mit vergleichsweise hoher Be- 
wegurigsdynamik ermittelte Skalenfaktorfehler als Kalman-Filterkorrekturwert fur 
die SkalenfaMor-FeMerkoirektur aller Messachsen des FOGs mit niedrigerer Bewe- 
10 gungsdynamik mit verwendet wird. 

2. Verfahren nach Anspruch 1 bei einem drei-achsigen Kurs- und Lagereferenz- 
system, dadurcn gekennzeichnet, dass der fur die Vertikalachse (z) ermittelte 
Skalenfaktorfehler zur Fehlerkompensation fur die ubrigen Messachsen (x, y) zur 

15 SkalerifaMor-FeMerkorrektur angewendet wird. 

3. Verfahren nach Anspruch 1 oder 2, dadurcn gekennzeichnet, dass die mit 
Hilfe des fur die Achse mit vergleichsweise hoher Bewegungsdynamik ermittelten 
Skalenfaktors zu bewirkende Fehlerkorrektur mit einer Zeitkonstante eingesetzt 

20 wird, die groJ3 ist gegenuber zu erwartenden kurzzeitig wirkenden, nicht modulier- 
baren bzw. kompensierbaren Fehlerquellen. 
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